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I.  INTBODECTION 

As  the  automation  of  labor  continues,  mobile  robots 
which  can  accurately  navigate  within  their  environments  will 
become  more  important.  Although  these  robots  may  not 
realize  the  humanoid  forms  of  the  science  fiction  writer, 
their  design  will  entail  several  general  characteristics. 
Foremost,  a  robot  has  a  central  controller  which  is  most 
commonly  a  microprocessor  or  a  network  of  microprocessors. 
Second,  the  robot  performs  a  task  or  multiple  tasks  which 
are  usually  too  repetitive  or  dangerous  for  their  human 
counterparts.  Finally,  the  controller  of  the  robot 
generally  controls  seme  type  cf  mechanical  motion.  This 
motion  includes  mechanical  manipulators  and  platform 
translation.  Admittedly,  these  characteristics  encompass 
many  systems  which  may  or  may  net  be  considered  robots,  but 
as  of  this  date,  there  is  no  accepted  definition  for  a 
robot. 

The  motivation  for  this  thesis  came  from  "A 
Microprocessor  Contrclled  Autonomous  Sentry  Robot",  a  thesis 
by  Hobart  fi.  Everett,  Lieutenant  Commander,  United  States 
Navy.  In  his  thesis,  LCDR  Everett  describes  his  first 
design  for  an  autonomous  sentry  robot.  LCDR  Everett  also 
states  the  need  for  absolute  position  information  by  which 
the  robot  may  effectively  navigate  £  Ref .  1  ]. 

Currently,  automated  mobile  platforms  obtain  position 
information  from  accelerometers,  open-loop  dead  reckoning 
(DR)  schemes,  or  remote  control  guidance.  Each  of  these 
methods  is  unacceptable  to  the  sentry  robot  concept.  First, 
accelerometers  are  too  expensive.  The  sentry  robot  is 
ideally  an  expendable  resource  since  it  may  operate  in  a 
hostile  environment.    It  is  also   a  relatively   slow  device 


with  small  accelerations  which  require  extremely  sensitive 
accelercmeters.  The  two  preceding  factors  force  the 
requisite  accelerometer  designs  to  be  cost  prohibitive. 
Secondly,  by  definition,  an  autonomous  sentry  robot  operates 
without  human  intervention.  This  requirement  eliminates  the 
numerous  remotely  controlled  systems.  Finally,  the  inherent 
errors  of  dead  reckoning  navigation  prohibit  its  use  as  a 
long-term  navigation  system. 

Even  with  the  most  accurate  DR  and  motion  detection 
devices,  position  errors  accrue  in  the  position  information 
due  to  measurement  errors.  Jiheei  slippage,  turn  radius 
errors,  quantization  and  axle/potentiometer  interfaces 
reduce  the  effectiveness  of  DR  navigation.  Quantization  and 
sensitivity  limit  the  accelerometer  guidance.  Accidents  or 
power  interruptions,  which  involve  the  robot,  adversely 
affect  both  DR  and  accelerometer  navigation. 

The  solution  requires  the  designer  to  fully  close  the 
navigation/position  control  loop.  The  robot  requires  a 
means  by  which  it  can  independently  update  its  position 
information.  This  information  comes  from  an  external 
absolute  reference  system.  To  be  effective,  the  reference 
system  must  eliminate  or  reduce  the  errors  previously 
discussed  and  be  inexpensive.  In  addition,  the  design 
requires  low  power  consumption,  small  component  size,  and 
ease  of  implementation.  Finally,  if  the  update  process 
operates  quickly  enough,  the  need  for  DR  navigation  is 
virtually  eliminated. 

Armed  with  accurate  position  data,  the  sentry's 
reconnaissance  need  not  be  random  patterns  like  those 
generated  by  Everett's  "Robart  I".  An  effective  sentry 
transits  the  entire  threat  area  in  a  timely  and  efficient 
manner.  While  random  motion  statistically  ensures  one 
hundred  percent  coverage,  there  is  no  guarantee  of  coverage. 
A  robot,  with  a  memory  map  as  described  by  Bradley  Heinstein 


in  [Kef.  2 ],  can  guarantee  one  hundred  percent  coverage  by 
recording  its  past  visit  times  in  areas  and  using  these 
times  to  establish  interim  navigation  goals. 

While  the  reference  system  described  within  this  thesis 
is  for  a  sentry  robot,  many  of  these  navigation  concepts 
apply  to  other  robctic  platforms.  One  example  is  an 
automated  platform  for  battlefield  use.  The  United  States 
Army  has  interests  in  this  area.  A  second  vehicle  is  an 
autonomous  underwater  vehicle.  Obviously,  an  underwater 
vehicle  is  of  great  interest  to  the  United  States  Navy. 

The  control  of  robot  manipulators  is  closely  related  to 
the  autonomous  sentry  robot's  control  problem.  Although  the 
movements  of  the  manipulator  are  constrained  with  respect  to 
those  of  the  sentry,  the  placement  and  accuracy  of  the 
reference  system  is  far  more  critical  with  the  manipulators. 
However,  the  manipulator  controller,  at  present,  still  faces 
the  same  problem  of  closing  the  open-loop  of  the  positioning 
system. 

The  repeatability  of  current  manipulators  is  .05  inches 
but  the  absolute  accuracy  is  orly  .5  inches  [Bef-  3].  Any 
improvement  in  accuracy  requires  better  machining  but  at  a 
significant  increase  in  cost.  Manipulators  have  gear  and 
wheel  slippage,  friction,  and  quantization  problems  just 
like  those  of  the  sentry  robot.  As  a  result,  the  designers 
must  include  tolerances  for  errors  or  a  human  operator  must 
reinitialize  the  manipulator  after  a  set  number  of 
movements.  In  order  to  more  fully  automate  these  processes 
and  improve  their  accuracy,  the  position  control  loop  needs 
to  be  closed  with  a  reference  system. 

This  thesis  explores  the  hardware  and  software  to 
develop  a  reference  system  for  both  the  sentry  robot  and  the 
robot  manipulator.  The  thesis  treats  the  sentry  robot 
problem  first  and  the  manipulator   problem  follows.    All  of 


the  research  involves  ultrasonic  sensors.  The  designs  use 
ultrasonic  sensors  Lecause  of  their  cost  and  availability  to 
the  student,  and  considering  that  the  medium  is  air, 
ultrasonic   devices   are      a   a    logical    choice.  The    theory   of 

Loth  systems  resides  in  the  next  chapter.  Chapters  three 
through  eight  contain  the  hardware,  software,  and  test 
results,  respectively,  for  the  autonomous  sentry  robot 
reference      system.  Following      the      sentry      robot      design, 

chapters  six  through  eight  present  the  manipulator  design  in 
the  same  manner.  Finally,  chapters  nine  and  ten  summarize 
the  conclusions  and  recommendations.  The  appendices  contain 
complete  copies  of  the  software  which  were  developed  plus 
additional  information  which  is  referenced  in  later 
chapters. 
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II.  THEOBY  AND  DESIGN 

The  general  design  for  both  the  sentry  robot  and  the 
manipulator  positioning  systems  uses  geometry  which  has  been 
used  in  nautical  navigation  fcr  many  years.  Given  only 
range  information  from  known  points  of  reference,  the 
mariner  plots  circles  of  equal  distance  centered  at  the 
reference  points.  The  intersection  of  the  lines  define  the 
mariner's  position.  Numerous  books  abound  which  discuss 
this  navigation  method.  This  thesis  will  not  discuss  these 
concepts  further  except  to  note  that  three  range  arcs  are 
required  to  ensure  an  unambiguous  position  or  fix  in  a  plane 
unless  other  information  is  available. 

The  sentry  robot's  reference  system  involves  two  or  more 
remote  ultrasonic  transmitters  at  known  locations.  When  a 
position  up-date  is  required,  the  robot  remotely  keys  the 
ultrasonic  transmitters  via  a  radio  frequency  link  and  meas- 
ures the  time  of  propagation  cf  the  sound  waves  from  the 
remote  site  to  the  robot's  ultrasonic  receiver.  Knowing  the 
speed  of  sound  in  air,  the  robct  determines  the  distance  to 
the  remote  site  using  equation  2.1  . 

distance  =  velocity  *  (total  time  -  delays)     (eqn  2.1) 

The  delays   will  be   discussed  later.     Figure  2. 1   shows  a 
typical  room  with  the  appropriate  geometry  plotted. 

A  robot  cannot  implement  this  procedure  graphically  but 
must  do  so  mathematically  via  a  microprocessor.  Appendix  A 
contains  a  detailed  derivation  cf  the  equations.  The  equa- 
tions which  describe  the  coordinates  of  the  intersections 
between  two  range  arcs  reduce  tc  a  quadratic  of  the  form 


1  1 


Figure  2.1   Typical  Room  with  Associated  Geometry 
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A*x**2  +B*x  +  C  =  0  (eqn  2.2) 


where 


A  =  4*  (0F1**2  +  0F2**2-2*0F1*0F2+DIF**2)  (eqn  2.3) 

B  =  4*  (0F2**3  -  0F1**3  +  (OF  1 -0F2)  *R 1**2        (eqn  2.4) 
+  0F1*0F2**2  ♦  (0F2*0F1**2  +  (R2**2)  *  (*0F  1-0F2) 

-  (DIF**2)*(OFUOF2)) 

C  =  R1**4  +  R2**4  +  DIF**4  +  CF1**4  +  OF2**4    (eqn  2.5) 
+  2*(- (R1**2)*  (0F1**2)  +  (R1**2)  *  (OF2**2)  +  (R2**2)  *0F1  **2 

-  (E1**2)  *(R2**2)  -  (R1**2) *  (IIF**2)  -  (R2**2) *DIF**2) 

-  (CF1**2)*0F2**2)  +  (DIF**2) *0F1**2) 

+  (DIF**2)  *{OF2**2)  -  (R2**2)  *(OF2**2) 

R1  =  range  to  site  cne  (eqn  2.6) 

R2  =  range  to  site  two  (eqn  2.7) 

OF  1  =  offset  from  reference  origin  to  site      (eqn  2.8) 
one  on  the  axis  of  the  coordinate  being  sought 

0F2  =  offset  from  reference  origin  to  site      (eqn  2.9) 
two  on  the  axis  of  the  coordicate  being  sought 

DIF  =  difference  in  the  offsets  of  the  two     (eqn  2.  10) 
sites  on  the  axis  of  the  coordinate  not  being  sought 

By  solving  equation  2.2  for  all  known  solutions,  the 
robot  determines  its  position  by  comparing  the  solutions  of 
the  various  pairs  of  range-arcs,  comparing  the  solutions 
with  its  estimated  current  position,  or  by  using  various 
restrictions.    For  example,   this   design  permits  operation 
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only  in  the  positive  quadrant  of  an  X-Y  grid  coordinate 
system.  Therefore,  the  program  discards  all  negative  solu- 
tions. The  design  also  uses  feet  as  the  fundamental  unit 
although  any  dimensional  unit  will  work  as  long  as  all  of 
the    quantities    are    uniform. 

Figure  2.2  contains  a  block  diagram  of  the  system. 
Whenever  the  robot  requires  an  update  of  its  position,  the 
robot's  master  microprocessor  or  a  slave  microprocessor 
which  may  be  dedicated  to  navigation  keys  the  appropriate 
ultrasonic  transmitter  by  correctly  emitting  the  corre- 
sponding radio  transmission.  This  requires  the  micropro- 
cessor to  interface  with  the  external  radio  transmitter. 
Simultaneously,  the  microprocessor  initiates  a  timer  which 
measures  the  time  of  propagation  of  the  sound  wave.  At  the 
remote  site,  a  radio  frequency  receiver  which  is  interfaced 
with  the  ultrasonic  transmitter  detects  the  appropriate 
radio   signal.  The    radio   receiver    triggers      the    ultrasonic 

transmitter.  An  ultrasonic  receiver  which  is  also  inter- 
faced with  the  navigation  microprocessor  detects  the 
ultrasonic   signal  at    the   robot. 

All  of  the  necessary  hardware  components  are  readily 
available,  small,  and  inexpensive.  Most  importantly,  the 
components  which  are  located  en  the  robot  are  low  power 
consumers  and  they  can  be  powered  down  when  not  in  use.  Low 
power  consumption  is  essential  to  a  truly  autonomous  robot 
since   its   power    supply  is  self-contained. 

While  the  sentry  robot's  position  system  is  primarily  a 
two-dimensional  problem,  the  manipulator  control  problem  is 
three-dimensional.  Again,  the  solution  uses  range  informa- 
tion, geometry,  and  ultrasonic  sensors  to  identify  the  posi- 
tion. However,  the  system  does  not  require  a  radio 
frequency  link.  Instead,  the  controlling  microprocessor 
interfaces  directly  with  the  transmitting  and  receiving 
ultrasonic    sensors.         The   problem    reduces    to   an    interface   of 
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*   uP  =  Microprocessor 

Figure  2.2    Sentry  Reference  System  Block  Diagram 

the  ultrasonic  components  and  a  software  package  for 
control.  Figure  2.3  shows  a  typical  system.  Figure  2.4 
contains  the  block  diagram  of  sxich   a  system. 

The  microprocessor  determines  the  manipulators  tip 
position  by  applying  the  law  of  cosines  to  the  range  infor- 
mation obtained  from  the  sensors.  By  placing  three  sensors 
in  the  same  plane  in  an  "L"  formation,  the  problem  simpli- 
fies and  takes  advantage  of  special  geometry.  Figure  2.5 
shows  the  geometry  of  the  system.  The  range  information  of 
any  two  sensors,  which  are  colocated  on  a  reference  axis, 
plus  their  respective  locations,  define  the  coordinate  of 
the  manipulator  on  the  axis.  The  two  range  vectors  form  two 
cones  which  share  a  common  base  when  the  vectors  are  rotated 
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Figure  2.3   Typical  Manipulator  Ultrasonic  Reference  System 
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Figure  2.4   Manipulator  Reference  System  Block  Diagram 

about  the  common  axis.  The  intersection  of  the  cones'  base 
plane  and  the  reference  axis  defines  the  actual  coordinate 
position  of  the  manipulator. 

First,  with  the  given  range  information  and  the  law  of 
cosines,  the  microprocessor  conputes  the  angle  of  departure 
of  the  range-vector  with  respect  to  the  common  axis  using 
equation  2.11 

Alpha  =  arcos  (  (AR**2+BR**2-AB**2)  /(2*AR*BR))    (egn  2.11) 


Alpha  =  angle  of  departure 


(egn  2.  12) 


AB  =  distance  between  the  sensors 


(egn  2.13) 
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Figure  2.5   Manipulator  Reference  System  Geometry 


AR    =   range   from   site   A    to    manipulator   tip  (eqn    2.14) 


BH    =   range   from   site   B    to    manipulator   tip  (eqn    2.  15) 

Next,  the  microprocessor  deternines  the  dot  product  of  the 
range-vector  and  the   respective   axis    using    equation    2.16    . 

Dot    product   =    AR*cos (Alpha)  (eqn    2.16) 

The  microprocessor  determines  the  actual  coordinate  by 
adding  the  dot  product  with  the  respective  site  offset  from 
the    system   origin. 

After  determining  the  seccnd  coordinate  in  the  above 
manner,  the  system  computes  the  last  coordinate  by  applying 
equation  2.17  which  relates  a  vector's  magnitude  with  its 
respective  projections  onto  a  three  dimensional  coordinate 
system. 

Z    =     (AR**2  -    X**2    -   Y**2)**.5  {eqn    2.17) 

X,Y,Z   =    the   respective   dot    products   of    the  (eqn    2.19) 

range  vector    on    the   axes 

This  geometry  permits  the  sensors,  which  establish  the  coor- 
dinate system,  to  lie  in  a  plane  outside  of  the  area  of 
movement  of  the  manipulator.  Also,  these  equations  handle 
ail  angles  from  zero  to  one-hundred  eighty  degrees  since  the 
cosine   function   is    single-valued   over    this   region. 

Neither  the  sentry  robot  nor  the  manipulator  designs 
focus  upon  a  particular  robot  design.  Instead,  the  author 
attempted  to  keep  the  designs  simple  and  transportable  so 
the  designs  could  be  interfaced  with  many  different  systems. 
Early      simulations      used      PL/I      on      the      Naval      Postgraduate 
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Schools  IBM  3033  system.  The  actual  test  design  involved 
FL/I-80,  Z-80  assembly  language,  the  Pro-Log  STD  7000 
Development      Station   and      exterrai  circuitry.  Programming 

occurred  on  an  Altos  computer  with  MP/M  II  which  contains  a 
Fl/I-80  compiler,  Macro-80  compiler,  Link-80  for  module 
linkage,      and     Genhex  for      hex-code    generation.  As   stated 

earlier,  the  above  choices  do  net  reflect  a  design  decision, 
but      instead,  reflect      the      availability        of      resources. 

Finally,  the  programs  maximize  their  generality  by  having 
the  hardware  interface  routines  and  the  clock  routines  in 
separate  modules.  These  routines  which  are  specific  to  each 
implementation  may  be  changed  without  seriously  affecting 
the    main  computational   program. 

The  remainder  of  this  thesis  presents  the  details  of 
these  test  designs.  The  hardware  and  software  of  the  sentry 
robot's      reference   system      is  first.  The     details  of      the 

manipulator  reference  system    follow. 
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III.    HJJDWARE    ZQI    2H    SENTRY    BOBOT^S    POSITIONING    SYSTEM 

From  the  beginning  of  this  design,  the  utilization  of 
"off-the-shelf"    components      was  a      primary    goal.  By    using 

components  which  are  currently  available,  the  design  is  less 
costly  and  the  designer  spends  less  time  "re-inventing  the 
wheel".  Instead,  the  designer  faces  numerous  interface 
problems  between      the  various    components.  However,       these 

interface  problems,  as  a  rule,  are  not  as  complex  or 
difficult  as  designing  the  entire  system  from  scratch.  This 
concept  parallels  current  efforts  in  VLSI,  custom  chip  and 
VHSIC  designs  where  proven  general  designs  are  slightly 
altered  for  each  specific  use.  Each  new  design  is  merely  a 
collection  of  building  blocks  which  have  been  previously 
designed,    tested,    and  implemented. 

The  microprocessor  interface  requires  five  logic  control 
lines  outbound  and  one  data  line  inbound.  While  these  lines 
could  be  directly  linked  to  the  external  circuitry  via  the 
data  bus  of  the  microprocessor,  this  is  not  a  safe  idea 
during  early  development  stages  when  many  changes  and/or 
accidents  may  occur.  Appendix  B  contains  an  eight  bit  I/O 
port  circuit  designed  by  David  Eigmaiden  of  the  Naval 
Postgraduate  School.  This  circuit  provides  protection  for 
the  microprocessor  and  an  addressable  input/output  port. 
The  design  uses  two  74138,  one  74273,  one  7432  and  one  74244 
chips.  The  circuit  includes  access  to  the  address  bus,  data 
bus,  and  the  respective  control  lines  such  as  read  and  write 
enable. 

The  radio  transmitter  and  receiver  sections  are 
available  at  Radio  Shack  (Catalogue  No.  277-10  12).  The 
remote  control  module  pair,  which  is  made  by  Archer,  operate 
at    27    ilHz      and    provide   four    control      functions.         Pulse   code 
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modulation  delineates  two  of  the  four  control  signals.  The 
other  two  control  signals  are  a  constant  carrier  signal  and 
the  absence  of  a  signal.  The  transmitter  requires  a  nine 
volt  EC  power  supply.  The  receiver  requires  both  a  three 
and   nine   volt   DC   power  supply.      [fief.    4] 

The  schematic  of  the  transmitter  is  in  Figure  3. 1  The 
interface  problems  between  the  transmitter  and  the 
microprocessor  are  twc-fold.  First,  the  microprocessor  must 
control    three  nine      vclt   power    supply    lines.  Second,      the 

microprocessor  must  ccntrol  three  low  impedance  connections. 
Normally,  two  double-pole/dourle-throw  switches  provide  the 
requisite   control. 

For  the  power  switching,  the  design  uses  reed  relays 
from  Claire  and  Archer.  These  devices  are  TTL  compatible. 
Figure      3.2   shows      the  respectiMe      wiring    diagrams.  Farly 

designs  considered  the  use  of  NEN,  CMOS,  and  VMOS  devices, 
however  the  nine  volt  switching  consideration  always  forced 
the  control  voltage  levels  beyocd  TTL  compatibility.  Thus, 
typical  microprocessor  control  was  not  possible  with  these 
devices. 

The  interface  circuit  for  the  low  impedance  lines  uses 
the  National  Semiconductor  CD4 066BM/CD4066BC  quad  bilateral 
switch  as  shown  in  Figure  3.3  .  This  analog  switch  is  TTL 
compatible  as  long  as  the  IC's  power-supply,  Vdd,  remains  at 
TTL  levels.  If  the  chip's  power  supply  exceeds  five  volts 
(maximum  allowable  voltage  is  fifteen  volts) ,  the  control 
voltages,  which  turn  the  switches  off  and  on,  must  also 
increase  beyond  TTL  levels.  This  fact  makes  these  switches 
unusable  for  the   power  switching  control    of    this   system. 

Armed  with  the  circuitry  of  Figures  3.2  and  3.3,  the 
microprocessor  keys  the  radio  transmitter  by  sending  the 
appropriate  code  to  the  I/O  port  at  address  "FF".  Table  I 
contains  the  respective  codes  and  their  consequences.  When 
all      connections      are     open,       nc      transmissions      exist.  A 
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combination  of  transmitter  connections  between  transmitter 
terminals  two  and  three  with  either  terminal  four  or  five 
powered  by  the  nine  volt  source  creates  the  respective  pulse 
code  modulation  from  the  transmitter.  The  connection  of 
transmitter  terminals  one  and  three  generates  the  constant 
27    MHz   carrier. 


TABLE   I 
Transmitter   Control   Codes 

00000 All    connections    open* 

10001    Constant    carrier    generation 

1011C 3000   hertz   pulse   code    modulation 

11010 500    hertz    pulse    code    modulation 

*    (The    most   significant   bit    is    the    left   bit.) 

The  receiver  schematic  diagram  is  in  Figure  3.4  The 
three  receivers  each  detect  the  complete  set  of  control 
signals.  The  receivers  have  three  power  sections  which  are 
normally  used      to   power   DC      servo   motors.  The    transistors 

which  control  these  fewer  sections  are  marked  in  Figure  3.4 
When  the  appropriate  signal  is  present  or  absent,  the 
collectors  of  the  controlling  transistors  have  associated 
voltage  levels.  An  1M311  comparator  tests  these  levels  and 
appropriately  keys  the  ultrasonic  transmitter.  Figure  3.5 
shows  the  comparator  and  the  interface  circuitry  which  keys 
the    ultrasonic    transmitter. 

During  this  research,  the  author  considered  two 
different      ultrasonic      devices,  the      Polaroid      Ultrasonic 

Ranging  System  and  the  National  Semi-Conductor  LM1812 
Ultrasonic  Transceiver  Driver  with  the  Panasonic  EFR-OTE40KZ 
Ceramic   Transducer.  The    Polaroid      device   is      an    excellent 

system  for  range  finding  during  obstacle  avoidance.  The 
half-power   bandwidth    is   narrow    at    ten    degrees.         It   also    has 
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an  automatic  sensitivity  control  which  enables  the  device  to 
provide  reliable  data  out  to  thirty-five  feet  [Bef-  5]- 
Although  this  device  was  used  at  the  remote  sites  for  the 
system  test,  the  LM1812  is  a  better  choice  at  both  the 
remote  sites  and  at  the  robot  as  a  receiver.  The  Polaroid 
device  uses  an  electrostatic  transducer  which  must  be 
polarized  to  receive  correctly.  The  device  must  either 
transmit  or  have  a  150  volt  power  supply  in  parallel  with 
the  transducer  to  correctly  polarize  the  device  [Bef.  6], 
In  a  receive  only  mode,  a  transnission  to  establish  this  150 
volt  differential  is  unacceptable  and  the  circuitry  which  is 
required  to  maintain  a  constant  150  volt  level  is  too  costly 
in  power  consumption.  The  Panasonic  transducers  are  ceramic 
devices  which  are  permanently  polarized.  Thus,  the  device 
is  passive  in  a  receive  only  mode. 

Also,  this  positioning  concept  requires  omni-directional 
transmission  and  reception.  Comparing  the  3-db  beam  width 
of  the  Polaroid  and  Panasonic  devices,  the  Panasonic 
transducers  need  far  fewer  transducers  operating  in 
parallel.  The  Panasonic  3-db  beam  width  is  sixty  degrees 
[Ref.  7].  Therefore,  the  receiver  needs  only  six  Panasonic 
devices  versus  thirty-six  of  the  Polaroid  design.  Each 
transmitter  site  needs  only  three  Panasonic  transducers  to 
provide  one-hundred  and  eighty  degrees  of  coverage  (if  the 
transmitter  is  placed  against  a  wall) . 

Figure  3.6  contains  the  circuit  diagram  for  the  LM1812. 
The  diagram  contains  a  complete  design  which  will  both 
transmit  and  receive.  The  connections  marked  with  an 
asterisk  need  not  be  made  when  the  device  is  acting  only  as 
a  receiver. 

Figure  3.7  contains  the  circuit  diagram  for  the  Polaroid 
system.  Texas  Instruments  now  markets  an  improved  version 
of  the  Polaroid  Ranging  Module,  which  is  called  the  SN28327. 
The  SN28827  uses  two  Texas   Instrument  chips,   the  TI852  and 
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TL851.  However,  this  unit  is  compatible  only  with  Polaroids 
electro-static  transducer  and  thus  the  lack  of  permanent 
polarization  remains. 

Finally,  three      separate        devices      provide        voltage 

regulation  for  the  circuitry.  All  nine-volt  sources  use  the 
LM317.  The  six-volt  sources  use  the  LM340T-6.0  and  the 
three-vclt      sources      use    LM723CM.  The      different      current 

requirements  of  the  three  voltage  supplies  determined  the 
device      which      was      employed.  Figure      3.8      contains      the 

regulators   and    their    external   circuitry. 

As  stated  earlier,  the  microprocessor  interface  contains 
five      outbound    lines      and   one      input.  The    outbound      lines 

merely  act  as  switches  to  turn  the  respective  transmitters 
on  and  off  along  with  the  requisite  power  supply.  The  lone 
input  line  tells  the  microprocessor  whether  an  ultrasonic 
signal  is  present  at  the  receiver  or  not.  Therefore,  the 
entire      power        for      timing,         calculation,  and      distance 

determination  lies  within  the  software  portion  of  the  system 
which    is  discussed    in  the   next    chapter. 
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17.  SOFTWARE  FOB  THE  SENTRY  BOBOT1S  POSITIONING  SYSTEM 

The  structure  of  the  software  package  is  modular  so  that 
the  portability  of  the  package  is  increased.  The  package 
has  two  requirements  which  are  unique  to  each  microprocessor 
or  robot  design.  First,  the  system  needs  a  timing  function 
which  may  be  realized  in  a  hardware  or  software  clock. 
Second,  the  input/output  port  control  is  unique  to  each 
microprocessor  design.  Both  of  these  variable  segments 
reside  in  assembly  language  nodules  .  As  long  as  the 
appropriate  control  signals  reach  the  external  circuitry  and 
the  correct  propagation  times  return  to  the  main  program, 
the  major  portion  of  the  progran  needs  no  change. 

Appendix  C  contains  a  listing  of  all  of  the  programs. 
Figure  4.1  contains  a  flow  diagram  of  the  basic  logic  of  the 
program.  The  main  program  initiates  the  majority  of  the 
system  variables  including  those  which  are  passed  between 
the  PL/I  language  programs  and  the  assembly  language 
programs.  Following  the  above  initialization,  the  PL/I 
program  calls  an  assembly  language  program  which  is  called 
INIT  to  initialize  the  Pro-Log  7804  Z80A  Processor 
Counter/Timer  Card  which  is  resident  in  the  STD  7000  work 
station.  This  hardware  clock  provides  the  requisite  timing 
function.  For  this  system,  the  clock  acts  as  a  down  counter 
which  counts  .0002  second  intervals.  Whenever  an  interval 
expires,  the  counter/timer  card  generates  an  interrupt.  The 
assembly  language  subroutine  CLCCKSR  services  the  interrupt 
by  incrementing  and  storing  the  clock  count.  CLOCKSR  also 
checks  for  a  time-out  condition  and  sets  the  appropriate 
error  flag.  The  time-out  and  error  flag  will  be  discussed  in 
more  detail   later. 
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After  initializing  the  clock,  the  PL/I  program  serially 
keys  the  remote  transmitter  sites  via  the  assembly  language 
program  KEY.  This  is  the  only  parameter  passing  which 
occurs  between  two  different  t^pes  of  language  routines  in 
this  system.  KEY  starts  the  clock  and  passes  the  code  to 
the  output  port  which  controls  the  radio  transmitter. 
Subsequently,  KEY  goes  into  a  loop  which  polls  the  input 
port  and  the  time-out  flag  for  a  change  of  status.  Once  a 
change  in  status  is  detected,  KEY  stores  the  data  and 
returns  control  to  the  PL/I  program. 

Between  each  measurement  c}cle,  the  transducers  need 
debouncing  to  prevent  erroneous  signal  detection.  The  HAIT 
subroutine  provides  this  feature.  WAIT  tests  the  input  port 
for  the  presence  of  a  signal  and  upon  finding  no  signal,  it 
begins  a  decrementing  counting  loop  which  gives  the 
transducer  "ringing"  sufficient  time  to  die  out.  When  the 
count  reaches  zero,  WAIT  returns  control  to  the  PL/I 
program. 

Once  the  propagation  times  are  returned  to  the  PL/I 
program,  the  PL/I  subroutine  CO  NT  I II  converts  the  time  of 
propagation  into  distance  using  equation  2.1  .  The 
remainder  of  the  PL/I  program  iipiements  the  solution  cf  the 
range-arc  intersection  problem  which  was  described 
previously.  Finally,  the  program  passes  the  desired 
information  to  the  CET.  In  an  actual  robot,  other  programs 
or  microprocessors  would  use  this  information  for 
navigation. 

Four  features  cf  this  system  require  additional 
discussion.  First,  if  the  ultrasonic  receiver  fails  to 
detect  a  signal,  the  system  wculd  stall  indefinitely  while 
it  awaits  a  signal  detection  unless  a  provision  is  made  to 
cover  this  possibility.  The  time-out  flags  handle  this 
situation.  In  the  clock  service  routine,  the  program 
compares  the  current  value  of  the  clock  count  with  the  value 
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which  equates  to  the  largest  dinension  of  the  room.  If  the 
clock  count  exceeds  this  value,  the  error  flag  is  set.  A 
propagation  time  larger  than  the  maximum  dimension  of  the 
grid  places  the  robot  outside  the  grid  coordinates. 
Obviously,    this    can    not    happen. 

The  second  feature  involves  the  reactions  to  various 
combinations      of      data.  If    all      three      remote      sites      are 

detected  (all  time-out  flags  unset)  ,  the  program  solves  the 
intersection  for  two  pairs  of  range-arcs  and  compares  these 
solutions      to        find      the      correct      position.  As      stated 

previously,  the  worst  case  solution  for  any  pair  cf 
range-arcs  is  two  sclutions  with  all  positive  coordinates. 
This  causes  an  ambiguity.  The  second  pair  merely  resolves 
the    ambiguity. 

When  only  two  range-arcs  are  detected,  the  program 
computes  their  intersection  and  resolves  any  ambiguities  by 
comparing  the  positions  with  the  best  estimate  of  the 
current  position.  The  robot  accepts  the  solution  closest  to 
its  estimate  of  position.  This  is  a  reasonable  assumption 
since  the  basic  concept  identifies  a  need  for  the  robct  to 
update   its   best   estimate   of    position    with    this   system. 

The  third  feature  consists  of  the  cases  where  only  one 
or  no  ultrasonic  signals  are  detected.  In  the  former  case, 
the  program  prints  an  error  message  and  the  available  data. 
In  the  latter  case,  the  program  prints  only  an  error 
message.  In      an   actual      implementation,         the      navigation 

package  should  continue  to  guide  the  robot  by  dead-reckcning 
(DR)  while  the  remote  sites  are  polled  again.  This  is  true 
in    both    cases. 

The  final  feature  also  concerns  erroneous  data.  PL/I 
provides  error  routines  which  assist  the  microprocessor  in 
recovering  from  calculation  errcrs  such  as  taking  the  square 
root  of  a  negative  number.  When  this  occurs,  the  data  is 
bad    from    one   or    more    remote      sites    but    no    time-out    flags   are 
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set.  In  this  program,  the  system  returns  to  the  CP/M 
operating  system.  In  an  actual  implementation  the  system 
should  repeat  the  polling  process  in  the  same  manner  as  when 
there  is  one  or  no  receptions  of  the  ultrasonic  signal. 
Again,  the  dead-reckoning  duties  continue. 

In  summation,  each  of  these  features  attempts  to  counter 
a  set  of  less  than  optimum  conditions.  In  the  event  these 
conditions  occur,  the  robot  continues  to  DR  itself  which  is 
the  current  convention  or  at  woist,  the  robot  can  halt  its 
motion  until  a  good  set  of  data  is  obtained.  Looping 
through  the  remote  keying  segment  of  the  program  provides 
successive  attempts  to  relocate  the  robot  and  eliminate  the 
problem.  With  this  being  the  case,  recognizing  an  error 
becomes  the  major  worry  and  not  so  much  what  the  error  is. 

Finally,  the  passing  of  parameters  between  the  PL/I  and 
the  assembly  language  modules  needs  further  discussion.  The 
discussion  of  this  subject  in  [fief.  8]  is  not  adequate. 
Basically,  whenever  a  PL/I  routine  calls  an  assembly 
language  subroutine  or  function  and  passes  the  module  a 
parameter,  the  PL/I  program  leaves  an  address  in  the  HL 
register  pair.  The  program  follows  the  normal  addressing 
scheme  with  L  containing  the  lower  byte  of  the  address. 
This  address  points  to  the  first  entry  in  an  array  which 
contains  the  addresses  of  each  of  the  parameters  which  are 
being  passed.  Again,  the  normal  address  convention  prevails 
as  the  low  order  byte  is  stored  first.  This  second  address 
is  the  physical  address  which  is  assigned  to  the  variable 
for  the  duration  of  the  program.  Any  program  which  accesses 
this  variable  must  use  this  address.  As  a  result,  all 
assembly  language  programs  which  return  data  to  a  PL/I 
program  simply  place  the  data  at  the  physical  address  and 
return  control  to  the  PL/I  program.  The  PL/I  program  has 
conventions  for  remembering  the  addresses  of  the  variables. 
Figure  4.2  contains  an  example.   [Ref.  8] 
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HL  register  upon  entry  into  L    00H 

assembly  language  program  H    20H 

(pointer  to  address  list) 

Data  at  address  2000H  2000H     00H 

(address  of  variable  1)  2001II    50H 

Variable  1  location  (1  byte)  5000H    xxH 

Variable  1  location  (2   bytes)  5000H     xxH 

(low  order  byte  at  5C00H)  5001H     xxH 

The  assembly  language  program  places  data  at  addresses 
5000H  (1  byte)  or  5000H  and  500  1H  (2  bytes)  to  return 
data  to  the  ?L/I  program.   No  other  conventions  are 
required. 

If  a  second  variable  is  passed,  HL  plus  two  contains 
the  address. 

HI  after  two  increments  L     02H 

H     20H 

Lata  at  address  2002  2002H     FFH 

2003H     50H 

Varible   2   location     (1   byte)  50FFH  xxH 

Figure  4.2        PL/I   -  Assembly    language   Parameter   Passing 


One  additional  word  of  caution  is  necessary.  The  actual 
definition  of  the  variable  (eg.,  8-bit  integer,  15-bit  real 
number)  determines  how  many  bytes  are  required  to  represent 
a  variable.  For  example,  a  fifteen  bit  real  number  requires 
two  bytes.  Each  byte  is  addressable.  When  a  PL/I  program 
passes  such  a  variable,  the  program  passes  only  the  address 
of      the    lowest      order  byte.  Si  thin      an    assembly      language 

program,  each  access  of  a  twc-byte  variable  requires  the 
manipulation   of    two    addresses. 

Discussions  about  the  program  timing  and  system 
feasibility  follow  in  the  next  chapter  with  the  results  of 
the    testing    phase. 
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V.  SEHTHY  COORDINATE  SYSTEM  TEST  RESULTS 

Although  the  implementation  was  not  optimum,  the  system 
works  to  within  an  accuracy  of  +/-  one  foot.  Figure  5. 1 
contains  a  diagram  of  the  rocm  in  which  the  test  were 
conducted.  Table  II  and  III  contain  eight  sample  points 
with  three  successive  attempts  at  each  coordinate.  The 
tables  list  the  respective  ranges  to  each  site  and  the 
coordinate  solutions.  For  example,  position  one  in  Table  II 
contains  four  entries  with  five  elements  in  each  entry.  The 
first  row  is  the  actual  measurements  and  coordinates  for 
position  one.  The  remaining  three  entries  are  measurements 
and  coordinates  which  were  produced  by  the  system.  The 
first  three  columns  list  the  distances  from  the  various 
transmitter  sites  to  the  test  position  while  the  remaining 
two  colunns  compose  the  X-Y  coordinates.  The  worst  case 
accuracy  falls  in  position  two  with  the  X  coordinate  in 
error  by  1. 1  feet.  Ihe  average  positional  error  for  all  of 
the  positions  is  0.54  feet.  Although  an  accuracy  of  one 
foot  initially  appears  to  be  large,  the  system  is  actually 
more  than  adequate  when  one  considers  the  entire  sensor 
package  which  is  located  on  a  mobile  robot.  For  both 
intruder  and  fire  detection,  sensor  ranges  come  in  tens  of 
feet.  Therefore,  the  robot  dees  not  need  greater  accuracy 
with  which  to  report  its  findings.  The  robot's  report 
contains  more  general  data  such  as  a  room  location  or 
sector.  On  the  other  hand,  the  accuracy  for  production  line 
work  is  far  greater.  During  proximity  navigation,  a  finite 
grid  reference  system  fails  ty  itself  when  faced  with 
dynamic  room  designs.  The  remainder  of  this  section 
presents  the  problems  with  cures  which  were  faced  during 
this  iirplementation. 
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TABLE  II 
Sample  Position  Coordinates 


Position    ( 

:ne 

Site    1 

Site 

2 

Site 

3 

X 

Y 

10 

7 

10 

10 

7* 

10.7 

7.6 

10.2 

10.3 

7.6 

10.3 

m 

9.7 

10.3 

7.4 

10.1 

7.4 

10.6 

10.  1 

7.4 

Position    Iwo 


10.8 

11 

10.  8 

10 

1  1* 

9.2 

11.  2 

11.31 

8.9 

1  1.  1 

8.9 

10.7 

10.  6 

9.  1 

10.6 

8.9 

11.4 

11.  1 

8.9 

1  1.3 

Position    Three 

14.6 

11.7 

7.2 

14 

1  1* 

15.6 

11.  9 

7.3 

14.6 

10.9 

13.6 

11.5 

6.9 

13.6 

10.9 

13.0 

11.3 

7.2 

13.1 

10.8 

Position  Fcur 

5.7  6.7  16.5  4  3* 

4.8  8.  1  17.4  3.8  3.4 

5.9  6.3                   16.6                4.7  3.1 
5.5                6.7                   16.4                4.4  3.9 

*      Ideal   measurements    and  coordinates 
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TABLE    III 
Sample   Position      Coordinates    (cont'd) 


Site    1 

Site 

2 

Site 

3 

X 

Y 

7.2 

11.7 

14.6 

6 

1  1* 

6.8 

1  1.9 

14 

6.1 

1  1.3 

7.1 

1  1.7 

14.  2 

6.  1 

11.1 

8.2 

11.  5 

14.6 

6.5 

10.9 

Position    Six 

10.1 

6 

10.  1 

10 

6* 

10.1 

6.8 

10.  1 

10.6 

6.9 

10.5 

6.4 

10.6 

9.9 

6.4 

10.3 

6.  18 

1  1.  1 

9.6 

6.1 

Pos 

ition    Seven 

16.5 

6.7 

5.7 

16 

3* 

16.7 

7.3 

4.9 

16.3 

4.1 

18.7 

7.  1 

5.3 

16.7 

2.  1 

16.7 

7.  1 

6.2 

16.7 

2.5 

Position    Eight 

12.2  9.2  8.2  12  9* 

11.9  9.2  8.6  11.7  9.1 

12.1  8.9  8.1  12  8.8 

12.6  9.7  8.6  12.4  8.8 

*      Ideal    measurements   aid   coordinates 
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Concerning  the  radio  transmitter/receiver  pairs,  the 
problems  were  three-fold.  First,  the  power  surges  which 
occur  as  the  radio  transmitter  is  turned  on  and  off  affect 
the      ultrasonic      receivers.  Ihis   results      in      false      echo 

detection.  The      power      supply   to      the      radio      transmitter 

requires  separate  voltage  regulation  (LM317)  and  filtering 
capacitors        (0. 1         uF)  to  eliminate        this        problem. 

Additionally,  the  radio  transmitter  board,  if  not  completely 
powered  down,  generates  erroneous  signals.  Although  these 
signals  are  not  of  the  three  required  waveforms,  the 
receivers  process  the  erroneous  signals  and  charge  various 
capacitors    to   unknown   levels.  This   condition   destroys    the 

reproducibility  of  the  data.  As  a  result,  the  system  design 
incorporates   the   reed  relays    to  control    the  power   switching. 

Secondly,  the  receiver's  initial  stage  is  a  Colpitts 
oscillator.  The  oscillator  directly  interfaces  with  the 
antenna  and  the  power  supply  with  no  buffering.  As  a 
result,  receivers  interfere  with  each  other  if  they  are  much 
closer  than  ten  feet  or  if  they  are  not  properly  isolated 
from      ground      loops.  Since      the      radio      link         works     at 

twenty-seven  mega-hertz,  a  .01  uF  capacitor  in  parallel  with 
a  1  uF  capacitor  provides  sufficient  filtering.  As  Douglas 
V.    Hall    states    in    [Ref.    9  ]# 


"Every  capacitor,  because  cf  its  leads  and  internal 
construction.  has  some  series  inductance.  This  series 
inductance  together  with  the  capacitance  forms  a 
series-resonant  circuit. .. above  the  resonant  freguency 
the  net  reactance  is  inductive.  increasing  as  the 
frequency  goes  up.  Because  of  the  increasing  inductive 
reactance  above  the  resonant  freauency.  the  capacitor  is 
becoming  less  and  less  effective  at  'shorting  out'  or 
filtering  out  high-frequency  voltage  transients. .. a 
combination  of  two  capacitors  thus  provides  filtering 
over    a   wide   range    cf    frequencies." 


Thirdly,  objects  in  proxinity  of  the  antennas  disturb 
the  respective  electromagnetic  propagation  patterns.  On  an 
actual   robot,       this    constraint    forces      the    antenna    on    top   of 
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the  robot  such  that  the  antenna  pattern  is  least  affected  by 
the  robot  body  itself.  Likewise,  rooms  with  large  numbers 
of  metal  objects  or  poorly  shielded  electrical  cable  alter 
these  patterns.  The  large  metal  desks  within  the  test  room 
(Figure  5.1)  caused  serious  degradation  of  the  system  when 
the  transmitter  was  within  two  and  one-half  feet.  However, 
since  the  radio  and  ultrasonic  circuits  were  not  fully 
shielded,  the  total  possible  reduction  of  these  effects  is 
not  available. 

Earlier  discussions  treated  some  of  the  problems  of  the 
ultrasonic  devices.  In  addition  to  the  requirement  for  full 
room  coverage,  two  additional  problems  arise  from  the 
ultrasonic  circuit  board.  first,  the  Polaroid  board 
contains  a  five  milli-second  delay  between  the  time  the 
transmit  cycle  is  initiated  and  the  actual  time  of  the 
ultrasonic  transmission.  This  delay  is  also 
non-reproducible  [Ref.  5].  While  this  did  not  grossly 
affect  the  system,  future  improvements  in  the  system 
accuracy  require  an  improvement  in  this  aspect.  The 
National  Semi-Conductor  LM18  12  has  no  documented  delay. 
Again,  the  LM1312  appears  better  for  this  application. 
Secondly,  the  gain  control  of  the  ultrasonic  receivers  is  a 
major  key  to  the  success  of  the  system.  This  implementation 
does  not  contain  an  automatic  gain  control.  [fief.  10]  has 
such  a  circuit  for  the  LM1812.  During  testing,  the  lack  of 
a  gain  control  necessitated  recalibration  of  the  time  delays 
whenever  the  robot  platform  moved  in  excess  of  +■/-  three 
feet.  With  an  automatic  gain  control,  this  calibration 
should  not  be  necessary. 

Finally,  an  older  copy  of  [Ref.  10]  (1977)  contains  a 
noise  reduction  tip  for  the  LM1812  chip  which  is  not  found 
in  later  versions.  "Inductive  kicks"  cause  erroneous 
ultrasonic  detections.  A  capacitor  of  approximately  30  pF 
between  pins  three  and  four  reduces  the  bandwidth  of  the 
receiver  and  filters  out  these  unwanted  noise  detections. 
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Initially,  assumptions  did  not  include  allowances  for 
circuit  delay  or  delays  in  the  radio  link.  However,  each 
link      has  a      different   delay.  Since   each      link    bases      its 

actuation  upon  a  different  signal,  one  expects  a  different 
delay  for  each  link.  As  expected,  the  delays  increase  as 
the  pulse  code  modulation  rate  decreases.  The  delays  for 
the  3000  hertz,  500  hertz  and  constant  carrier  are  .011, 
.071,        and      .098  seconds      respectively.  However,         these 

parameters     are      unigue      to         each      circuit!  The      program 

implements  these  corrections  via  the  constants,  DE11,  DE12, 
and    DEL3. 

In  conjunction  with  the  previous  discussions  on  the 
circuit  and  radio  link  delays,  the  major  time  constraints 
come    from      the   debouncing      features    of      the   program.  When 

three  signals  are  detected,  the  system  returns  a  solution  in 
a  total  time  of  1.5  seconds.  The  above  time  includes  one 
debouncing  call  before  keying  each  of  the  remote  sites.  The 
WAIT  program  incorporates  a  comtination  of  no  signal  and  an 
arbitrary  time  delay  to  debounce  the  receivers.  With  more 
accurate  testing,  the  time  for  debouncing  is  reducible.  Of 
course,  if  one  or  more  signals  are  not  detected,  the  total 
system   time  becomes   a  function    cf   the   time-out   conditions. 

Although  each  circuit  nominally  has  small  current 
reguirements,  the  short  term  reguirements  force  careful 
voltage  regulation  at  both  the  robot  and  at  the  remote 
sites.  In  addition  to  the  power  switching  of  the  radio 
transmitter,  the  remote  ultrasonic  units  also  cause  the  same 
problems.  For  the  Polaroid  devices,  the  circuit  reguires 
six  volts  at  two  and  cne-half  anps  for  one  milli-second.  A 
combination  of  an  LM340T-6.0  voltage  regulator  and  a  470  uF 
capacitor  at  the  load  prevent  the  ultrasonic  circuit  from 
disturbing  the  power  supply.  Interruption  of  the  power 
supply  disturbs  both  the  radio  receiver  and  the 
comparator/interface   circuits. 
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Obviously,  the  number  one  problem  of  an  ultrasonic 
system  is  obstructions.  For  this  reason,  the  actual 
implementation  of  this  design  on  a  robot  requires  the  radio 
antenna  on  top  of  the  robot  with  the  omni-directional 
ultrasonic  receiver  section  directly  underneath.  The 
highest  obstruction  within  the  environment  determines  the 
minimum  height  at  which  the  ultrasonic  system  may  be 
located.  Since  the  program  needs  a  minimum  of  two 
unobstructed  ranges  for  a  solution,  the  line  of  sight 
between  the  robot  and  two  of  its  remote  sites  must  remain 
clear.  As  long  as  the  prograa  knows  the  location  of  the 
sites  and  the  correct  distance  to  the  site,  the  coordinates 
are  obtainable.  Later  chapters  discuss  alternatives  for 
site  location  and  systems  with  more  than  three  remote  sites. 
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VI.  HARDWARE  FOB  THE  MANIPULATOR  REFERENCE  SYSTEM 

The  differences  between  the  sentry  robots  reference 
system  and  the  manipulator's  are  few.  However,  these  few 
changes  are  significant.  Overall,  the  design  requires  fewer 
components  and  is,  therefore,  less  complex. 

The  manipulator's  reference  system  does  not  have  the 
need  for  total  autonomy  which  the  mobile  robot  does.  As  a 
result,  all  of  the  peripheral  sensors  directly  interface 
with  the  microprocessor.  This  eliminates  the  need  for  the 
radio  links.  Additionally,  this  eliminates  all  of  the  noise 
which  is  associated  with  radio  transmissions. 

Second,  the  microprocessor  input/output  ports  reverse 
their  importance.  In  the  sentry  design,  the  output  port 
maintains  the  proper  control  of  the  three  remote  transmitter 
sites.  The  manipulator  uses  only  one  output  to  key  a  single 
transmitter  which  is  located  on  the  arm.  The  design  again 
uses  the  Polaroid  ultrasonic  device  as  the  transmitter.  The 
interface  circuitry  consists  of  the  normal  TTL  logic  signal 
for  the  microprocessor  and  the  comparator  circuitry  in 
Figure  6.1  which  was  used  at  the  remote  sites  in  the  sentry 
design. 

The  input  ports  change  from  an  omni-directional  receiver 
input  to  three  single  multiplexed  receivers.  No  actual 
wiring  changes  occur.  However,  the  software  services  the 
input  port  differently.  The  next  chapter  further  explains 
the  changes  in  the  software.  There  is  one  addition  to  the 
input  circuitry.  The  Polaroid  devices  do  provide  access  to 
the  actual  transmitter  driving  signal.  The  signal  name  is 
"XLOG".  This  signal  allows  the  system  to  begin  the  system 
clock  synchronously  and  also  improves  both  accuracy  and 
reproducibility  of  the  data.  Table  IV  contains  the 
input/output  port  configurations. 
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Figure  6.1   LM311  and  Interface  Circuitry  (Manipulator) 
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TABLE    17 
Port   Assignments  for  the   Manipulator 

Output 

Port Device 

0  CTltrasonic    transmitter 

1-7 No    connection 

Input 

Port Device 

0  Receiver    1 

1  Receiver    2 

2  Receiver   3 

3  XLOG    signal 

4-7 No   connection 

The  remaining  circuitry  r€mains  the  same  as  in  the 
sentry  design.  This  includes  the  microprocessor  workstation 
and  the  LM1812  ultrasonic  circuits.  A  three-quarter  inch 
plywood  board  provides  the  requisite  support  for  the  three 
ultrasonic   receivers. 

The  software  changes,  which  are  discussed  in  the  next 
chapter,      likewise,        are   few.  This  circuitry      provides   a 

simple  hut  effective  system  with  which  a  reference  system 
may  he  established.  However,  as  will  be  discussed  later,  a 
final  design  will  reguire  much  more  detailed  analysis  of  the 
transceiver  design  such  that  mere  uniform  coverage  may  be 
obtained. 
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VII.  SOFTWARE  FOB  THE  UMillliiTOl  REFERENCE  SYSTEM 

As  stated  previously,  the  sentry  robot  software  is 
modular  in  the  hope  that  it  might  be  more  portable.  The 
manipulator  software  also  follows  this  policy.  In  fact,  the 
manipulator  software  originated  from  the  sentry  robot 
software  with  only  a  few  changes.  Figure  7.1  contains  a 
block  diagram  of  the  system  logic.  Appendix  D  contains  the 
complete  program  listings. 

The  program  has  the  same  najor  sections  as  the  sentry 
robot's  program.  After  initialization,  the  main  program 
serially  determines  the  distance  between  the  three  receivers 
and  the  transmitter  which  is  located  at  the  manipulator  tip. 
This  procedure  involves  three  calls  to  the  assembly  language 
modules  as  in  the  previous  programs.  Next,  the  program 
checks  fcr  proper  reception  of  data.  If  the  data  is  bad, 
the  program  terminates  with  an  error  message.  If  the  data 
is  good,  the  program  first  calculates  the  iine-of- sight 
departure  angle  and  then  the  corresponding  axis  coordinate. 
Lastly,  the  program  prints  the  appropriate  data  onto  the 
CRT. 

Obviously,  the  calculations  which  are  made  in  the 
manipulator  program  are  different  from  those  of  the  sentry 
program.  However,  the  debouncing  and  time/distance 
conversion  modules  are  unchanged.  The  "ANGLE"  and  "CCORD" 
modules  replace  the  "P0SIT3"  and  P0SIT2"  modules.  By 
comparing  the  two  PL/I  programs,  their  similarity  becomes 
apparent. 

Just  as  expected,  the  main  changes  in  the  programming 
occurred  in  the  assembly  language  modules.  While  the 
parameter  passing  remained  unchanged,  both  the  clock  and  the 
receiver  polling  are  different.    To   obtain  a  more  accurate 
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Figure  7.1    Flow  Diagram  of  the  Manipulator  System  Logic 

clock,  the  program  implements  a  software  clock.  A  software 
clock  uses  a  specific  loop  with  a  known  execution  time  to 
increment  a  count  of  the  real  time.  In  this  case,  the  loop 
increments  in  .00005  second  intervals.  Within  the  loop,  the 
program  polls  the  input  port  for  the  appropriate  reception 
of  the  ultrasonic  signal.  The  transmitter  code  of  the 
sentry  robot  program  becomes  a  receiver  code  in  this  system. 
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During  the  polling  process,  the  microprocessor  "AND's"  the 
cole  with  the  input  from  the  pert.  Table  V  contains  these 
codes.  The  program  tests  for  proper  signal  reception  by 
checking  the  various  flags  which  are  set  by  the  "AND-ing" 
operation.  Upon  signal  reception  or  time-out,  the  program 
returns  control    and    data   to    the  PL/I   main    program. 

TABLE    V 
Receiver    Control    Codes 

0001      Receiver    1    reception* 

0010 -.    Receiver    2  reception 

0100 Receiver    3   reception 

1000 XLOG    signal   reception 

*    (The    most   significant   bit    is    the   left    position.) 

Since  both  the  receivers  and  transmitter  are  directly 
interfaced  to  the  microprocessor,  reduced  delays  and  more 
positive  ccntrol  are  possible.  Also,  the  XLOG  signal  which 
drives  the  ultrasonic  transmitter  interfaces  with  the 
microprocessor   and    initiates    the   software    clock,    loop. 

Finally,  while        this  system        encompasses        fewer 

alternatives  (no  degraded  modes) ,  the  system  still  must 
recover  gracefully  whenever  no  solution  is  possible.  If  any 
of  the  time-out  flags  are  set,  the  system  prints  an  error 
message.  Also,  if  the  data  does  not  provide  a  solution 
(eg.,  the  program  attempts  to  take  the  square-root  of  a 
negative  number),  the  PL/I  error  routines  print  the  error 
messages.  In  an  actual  implementation,  the  program  should 
simply  loop  for  another  attempt.  Currently,  the  loop  takes 
less  than  one  second.  These  problems  are  further  discussed 
in    the    test   results    which   follow. 
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VIII.  HANI POLA TOE  COORDINATE  SYSTEM  TEST  RESULTS 

With  the  elimination  of  the  radio  circuits,  the  accuracy 
and  consistency  of  the  distance  measurements  improve 
tremendously.  When  the  transmitter  is  stationary  and 
successive  measurements  are  taken,  the  differences  occur  in 
the  hundredths  of  a  fcot.  The  overall  positional  accuracy 
of  the  system  increases  to  the  tenths  of  a  foot.  Table  VI 
and  VII  contain  a  listing  of  sample  position  data.  The 
tables  list  the  respective  raiges  to  each  sensor  and  the 
coordinate  solutions.  For  example,  position  one  in  Table  VI 
contains  four  entries  with  six  elements  in  each  entry.  The 
first  row  is  the  actual  measurements  and  coordinates  for 
position  one.  The  remaining  three  entries  are  measurements 
and  coordinates  which  were  produced  by  the  system.  The 
first  three  columns  list  the  distances  from  the  transmitter 
to  the  respective  receivers  while  the  remaining  three 
columns  compose  the  X-Y-Z  coordinates.  The  worst  case 
accuracy  falls  in  position  seven  with  the  Y  coordinate  in 
error  by  0.32  feet.  The  average  positional  error  for  all  of 
the  positions  is  0.3  0  feet. 

Even  with  this  improvement  in  accuracy,  the  accuracy  is 
not  good  enough  for  truly  intricate  assembly  maneuvers. 
This  is  due  inpart  to  the  lack  cf  an  automatic  gain  control. 
Whenever  a  significant  change  in  the  transmitter  position  or 
orientation  occurs,  the  time  response  of  the  ultrasonic 
receiver  changes  as  previously  discussed  in  the  test  results 
on  the  sentry  robot  reference  system.  Secondly,  further 
research  is  necessary  to  fully  calibrate  such  a  system. 
This  calibration  includes  the  definition  of  a  reference 
point  on  the  transducer  fron  which  the  distances  are 
measured.      Additionally,     the   introduction    of    more 
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transducers   for   an  increase   in    coverage   adds   to   the 
calibration  problems. 

This  design,  however,  proves  the  feasibility  of  such  a 
system.  By  constraining  the  sensors  to  one  plane,  the 
manipulator  enjoys  a  full  range  of  unobstructed  motion-  The 
designer  places  the  reference  system  wherever  the  location 
is  most  convenient.  This  includes  floors,  ceilings,  walls 
or  in  the  face  of  the  manipulator  base.  Thus,  the  reference 
system  may  be  absolute  when  it  is  stationary  or  relative 
when  it  is  rotated  on  the  base. 

The  system  loop  takes  less  than  one  second  to  complete. 
Again,  the  debouncing  routine  causes  the  longest  delay.  A 
reduction  in  this  delay  will  optimize  the  system  response 
since  the  WAIT  routine  is  called  three  times.  This  design 
does  not  minimize  this  delay.  Additionally,  the  delays  for 
the  three  receivers  are  .023,  .019,  and  .022  seconds  for 
receivers  one,  two,  and  three  respectively.  These  delays 
are  also  much  less  than  the  sentry  robot  design  because  they 
do  not  include  the  radio  link  delay  with  its  pulse  code 
modulation. 

Most  of  the  improvement  in  consistency  of  the  data  is 
attributable  to  the  usage  of  the  XLOG  signal  from  the 
ultrasonic  circuit  beard.  This  signal  eliminates  the  need 
to  estimate  the  five  milli-second  delay  between  the 
activation  of  VSW,  the  keying  signal,  and  the  actual 
transmission.  Instead,  the  clock  begins  its  count  when  the 
actual  transmission  signal  originates.  The  LM1812  has  no 
such  comparable  signal  unless  the  transmission  signal  to  the 
transducer  head  is  used. 

The  system  concept  is  feasitle.  With  the  gain  control 
and  further  calibration,  the  desired  system  accuracy  should 
be  obtainable. 
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TABLE  71 
Sample  Position  Coordinates  (Manipulator) 

Position  Cne 


Site    1 

Site    2 

Site 

3 

X 

Y 

Z 

.833 

.666 

.750 

.5 

.833 

.833* 

.834 

.666 

.750 

.65 

.75 

.80 

.834 

.723 

.750 

.69 

.69 

.81 

.834 

.666 

.750 
Posit 

ion 

.65 
Two 

.75 

.81 

.567 

.636 

.756 

.5 

.5 

.29* 

.436 

.55 

.86 

.32 

.39 

.21 

.4  36 

.55 

.86 

.32 

.39 

.21 

.437 

.55 

.86 

.32 

.39 

.21 

Position  Three 

.52       .726       .527       .5  .333  .666* 

.266      .836       .41        .25  .23  .5 

.266      .893       .41        .25  .21  .5 

.266      .836       .419       .25  .23  .5 

Position  lour 


1.  16 

1.05 

1.12 

1.0 

.833 

.833* 

1.  16 

1.05 

1.07 

.33 

.92 

1.07 

1.  16 

1.05 

1.  12 

.94 

.915 

.85 

1.16 

1.04 

1.07 
Position 

.83 
live 

.915 

1.07 

1.03 

1.07 

1.  15 

1.0 

.5 

.3* 

.88 

.99 

1.06 

.81 

.36 

.  17 

.88 

.94 

1.07 

.80 

.46 

.17 

.87 

.935 

1-07 

.80 

.46 

.  17 

Ideal  measurements  and  coordinates 
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TABLE  VII 
Sample  Positions  (Manipulator  cont'd) 

Position  Six 


Site  1 

Site  2 

Site 

3 

X 

Y 

Z 

1.08 

1.  16 

1.0 

1.0 

.33 

.83* 

1.  13 

1.34 

1.  10 

1.04 

.  12 

.80 

1.02 

1.29 

.932 

.84  1 

.05 

.92 

1.13 

1.34 

1.10 

1.04 

.01 

.80 

Position 

Seven 

1.0 

1.  11 

1.04 

1.0 

.33 

.5* 

1.01 

1.  15 

1.04 

1.01 

.29 

.61 

1.01 

.98 

1.  10 

.96 

.65 

.42 

.91 

1.  10 

.92 

.89 

.21 

.60 

Position  Eight 

1.16      1.12       1.05       1.0  .83  .83* 

1.13      1.0        1.01       .75  .92  1.1 

1.13      1.0        1.07       .88  .92  .89 

1.07      .89        1.01       .767  .99  .86 

Position  Kine 


1.06 

1.08 

1.0 

1.0 

.79 

.54* 

1.  11 

1.  12 

1.04 

1.0 

.56 

.89 

.99 

1.01 

.932 

.91 

.54 

.83 

.99 

.95 

1.  10 
Position 

.94 
len 

.79 

.49 

1.19 

1.  12 

1.37 

1.0 

.75 

0.0* 

1.27 

1.  18 

1.38 

1.1 

.94 

.  15 

1.3 

1.24 

1.5 

.91 

.98 

-.22 

1.33 

1.29 

1.5 

1.02 

.79 

-.20 

Ideal  measurements  and  coordinates 
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IX.    CONCLUSIONS 

The  position  control  loop  in  robotics  no  longer  needs  to 
be  a  semi-closed  loop.  With  an  ultrasonic  reference  system 
in  place,  positive  control  of  a  mobile  platform  or 
manipulator  is  possible.  Also,  a  reference  system  limits 
the  cumulative  error  since  it  becomes  a  function  of  the 
coordinate      system's      recursive      cycle.  Armed       with      this 

information,  a  controller  can  implement  more  sophisticated 
guidance  packages  without  complicated  error-correcting 
software. 

The  cost  of  such  a  system  is  not  prohibitive.  The  cost 
of  the  major  components  keep  the  total  system  hardware  cost 
well  below  $250.00.  Even  with  more  dedicated  designs,  the 
system  cost,  when  mass-produced  to  lower  the  cost  further, 
makes   the   reference      system    an    expendable   commodity.  As  a 

matter  of  fact,  a  single  prirted  circuit  board  design  is 
easily  conceivable  which  would  permit  the  maintenance 
operator  to   simply   remove   and   replace  the   entire    system. 

Since  the  device  reed  not  be  powered  continuously,  the 
system      is      a   low      power      consumer.  This   is      a      mandatory 

reguirement      for   an      autonomous   robot.  Even  the      Polaroid 

device  with  its  two  and  one-half  ampere  current  reguirement, 
operates      successfully      on  batteries.  Polaroid      uses      the 

Polapulse  battery  for  power  in  its  test  and  evaluation  kits 
[fief.    5].      Therefore,    the   power  considerations  are    minimal. 

While  the  two  systems  failed  to  achieve  the  desired 
increase        in      accuracy,  closer        cooperation      with        the 

manufacturers  and  additional  research  surely  can  improve  the 
system    accuracy.  The   chapter   on      recommendations    includes 

hints  by  which  the  accuracy  of  the  systems  may  be  improved. 
Most      importantly      though,         any        implementation      of      these 
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ultrasonic  devices  dictates  the  use  of  an  automatic  gain 
control.  Unfortunately,  this  research  only  identified  this 
problem  and  the  cure.   Neither  design  contains  this  control. 

Of  course,  the  number  one  enemy  of  an  ultrasonic  system 
is  obstructions.  If  the  signal  can  not  reach  the  receiver 
via  its  line  of  sight,  the  system  does  not  work.  Therefore, 
within  reason,  the  concept  requires  sufficient  reference 
transmitters/receivers  to  provide  one-hundred  percent 
coverage.  As  the  number  of  transmitter/receiver  sites 
increases,  the  complexity  of  the  encoding  schemes  which 
control  these  sites  increases.  The  sentry  system  requires 
at  least  two  ranges  at  all  times  while  the  manipulator 
requires  at  least  three.  The  environmental  geometry 
dictates  the  actual  number  required. 

Although  the  use  of  PL/I  was  expected  to  hamper  the 
system  speed,  this  was  clearly  not  the  case.  The  main  time 
delay  of  either  system  is  the  various  debouncing  routines, 
the  signal  propagation,  and  the  time  delay  of  the  external 
circuitry.  Accordingly,  the  use  of  a  faster  (greater  than 
two  mega-hertz)  or  larger  (greater  than  8  bits) 
microprocessor  will  not  provide  a  corresponding  payoff  in 
throughput.  Until  the  other  delays  are  reduced,  the 
emphasis  of  future  designs  should  focus  upon  optimizing 
these  circuits  and  components. 

As  stated  earlier,  the  Polaroid  ultrasonic  unit  is  an 
excellent  device  for  ranging.  The  unit  is  easy  to 
incorporate  into  designs  and  is  extremely  reliable. 
However,  in  this  design,  it  fails  to  provide  sufficient 
receive-only  capability  and  beam  width.  The  Panasonic 
EFR-OTEU0K2  transducer  when  incorporated  with  the  LJS1812 
provides  far  better  results,  even  though  the  LM18  12  requires 
far  more  circuitry. 

Finally,  this  thesis  cannot  over  emphasize  the  necessity 
of  following   good  "breadboard   techniques".    Although   the 
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following  list  may  seem  obvious,  the  number  of  hours  spent 
trouble  shooting  problems  associated  with  the  list  was 
large. 

1.  Regulate   all    power   supplies. 

2.  Use  filtering  capacitors  liberally.  Remember,  it 
may  reguire  two  in  parallel  to  fully  cover  the 
reguisite  bandwidth. 

3.  Use  heatsinks  on    all    regulators. 

U.      Use   only    good  breadboards   or    wire-wrap. 

5.  Follow    good    solder   techniques. 

6.  Use  coaxial  cable  wher  possible,  especially  when 
the   distance   is   over    six  inches. 

7.  Do    not    underestimate   the  power    of    proper    shielding. 

8.  Plan   your   layout   carefully. 

9.  Color  code    your   wiring. 

10.  Divide    and   ccnguer   or   segment  and    test. 
Ultrasonic        reference        systems      are        realizable        and 

feasible.  This      thesis      reflects    this.  The      future     of 

robotics  should  no  longer  contain  open  loop  designs.  The 
reference  systems  car  be  inexpensive,  accurate  and  low 
power.      Closed   loop    control    is    possible. 
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X.  RECOMMENDATIONS 

Both  the  sentry  and  manipulator  reference  system  designs 
provide  a  means  by  which  the  position  control  loop  can  be 
closed.  As  stated  in  LCDR  Everett's  thesis  and  numerous 
other  texts  and  reference,  separate  microprocessors  should 
implement  these  functions  in  parallel  with  the  master 
microprocessor.  However,  the  designs  need  further  research 
and  development. 

Foremost  in  the  sentry  design  is  the  need  of  a  more 
consistent  radio  link.  The  problems  which  were  attributed 
to  the  Cclpitts  oscillator  can  be  eliminated  with  a  better 
design  and  a  change  in  operating  frequency.  Of  course,  a 
final  implementation  requires  greater  attention  to  circuit 
and  cabie  shielding.   Antenna  placement  is  also  important. 

Second,  the  integration  of  the  transducer  into  a 
functioning  system  while  obtaining  the  necessary  coverage  is 
important.  Unless  an  omni-directional  transducer  is 
available,  any  design  will  require  multiple  transducers 
working  in  parallel  both  at  the  transmitter  and  receiver 
locations.  While  this  may  be  less  of  a  problem  in  the 
sentry  design,  the  manipulator,  with  its  infinite 
orientations,  is  a  most  difficult  problem.  These 
applications  might  require  an  original  transducer  design. 

Transducer  sensitivity  is  controllable  through  external 
circuitry  on  the  LM1812.  Since  the  Polaroid  device  provides 
excellent  control  of  the  sensitivity  out  to  a  range  of 
thirty-five  feet  (seventy  feet  including  the  return  path) , 
the  range  of  current  devices  is  more  than  adequate  for  the 
manipulator  and  the  sentry  rotot  for  indoor  uses.  Any 
implementation  which  uses  ultrasonics  needs  this  sensitivity 
control,    especially  when   the  operating   distances  are  in 
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close  proximity.  Without  the  automatic  gain  control,  the 
time  delays  are  variable  and  dependent  upon  the  distance  or 
signal  strength  which  is  unknown.  Further,  no  device 
currently  employs  gain  control  on  the  transmitter.  In  a 
closed  loop  and  close  proximity  system  such  as  these,  the 
transmitter  gain  control  might  use  the  estimated  position  as 
as  reference  by  which  the  gain  is  varied.  This  permits  the 
usage  of  constant  gain  receivers  in  a  multiple  receiver 
syst  em. 

Although  the  velocity  of  sound  is  not  critically 
dependent  upon  temperature,  it  is  none  the  less  a  function 
of  temperature.  The  LM39  11  easily  provides  temperature 
sensing  which  may  be  directed  to  the  navigation 
microprocessor.  With  the  correct  ambient  temperature,  the 
microprocessor  updates  the  speed  of  sound  with  which  the 
time/distance  conversions  are  made.  A  change  from 
sixty-eight  to  sixty-nine  degrees  Fahrenheit  translates  to 
an  additional  one  foot  per  second  in  velocity. 

Although  the  basic  calculations  will  not  change,  the 
error  handling  within  each  software  package  is  unigue  to 
each  application.  While  looping  successively  through  the 
program  is  an  obvious  choice  to  correct  a  fault,  the 
designer  faces  more  important  guestions.  Should  movement 
continue?  How  fast  can  actions  continue?  How  large  are  the 
tolerances?  The  designer's  considerations  include  the 
machine  and  the  environment.  Finally,  redundancy  improves 
reliability  and  accuracy  but  it  increases  cost  <ind 
complexity. 

Even  though  the  accuracy  of  the  robot  sentry  and 
manipulator  designs  does  not  improve  upon  the  current 
accuracies  of  systems  without  such  references,  the 
theoretical  limits  of  accuracy  which  are  a  function  of 
frequency  are  far  better  than  current  systems  provide.  For 
example,  at  fifty  kilo-hertz,   the  wavelength  is  .272  inches 
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or  .69  centimeters.  At  200  kilo-hertz,  the  wavelength  is 
.068  inches  or  .173  centimeters.  Since  the  signal  detection 
depends  upon  the  rising  edge  of  the  incoming  signal, 
accuracies  of  this  magnitude  are  possible.  Any  delays  are 
of  no  consequence  as  long  as  the  deiajS  are  consistent. 

With  the  final  design  perfected,  the  desired  positive 
control  is  possible.  Martin  Weinstein  in  [Ref.  2]  gives  a 
very  detailed  description  of  a  memory  map  with  which 
navigation  planning  and  obstacle  avoidance  might  be 
performed.  However,  two  additional  items  should  be 
considered.  First,  any  navigation  scheme  needs  an  endpoint 
or  goal.  Second,  the  memory  map  needs  to  incorporate  visit 
time  within  its  structure.  The  goal  in  a  sentry's 
reconnaissance  is  one  hundred  percent  coverage  of  the 
security  area  in  a  timely  manner.  Therefore,  the  interim 
goal  becomes  one  of  visiting  the  block  with  tne  oldest  visit 
time.  Once  the  goal  is  determined,  the  navigation  unit 
decides  the  optimum  path.  As  the  robot  transverses  the 
chosen  path,  the  navigation  microprocessor  updates  the  visit 
times  of  the  blocks  which  are  crossed  plus  ALL  BLOCKS  WHICH 
PALL  INTO  THE  SECURITY  OR  FIRE  DETECTION  RANGE  OF  THE 
ROBOT'S  SENSORS!  This  scheme  allows  the  sentry  to  provide 
one-hundred  percent  coverage  since  a  block  which  is  not 
visited  will  eventually  become  an  interim  goal  as  its  visit 
time  grows  to  exceed  all  others.  Weighting  factors  which 
are  associated  with  high  risk  areas  improve  the  revisit 
times  to  these  areas. 

1CDR  Everett  mentions  path  planning  routines  such  as  the 
computer  game  "Othello".  Also,  in  [Ref.  11],  four  papers 
addressed  this  issue.  They  are  listed  in  the  bibliography. 
However,  the  work  by  Keirsey  et  al.  at  the  University  of 
Florida  and  at  Hughes  Research  Laboratories  looks  very 
promising.  In  their  paper  [Ref.  12],  this  group 
substantiates   their   work  in   tactical   navigation.     More 
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specifically,  their  work  includes  search  graph  construction 
and  heuristic  searches  for  path  planning. 

The  Zenith  Corporation  currently  markets  an  ET-18  Rofcot 
Remote  Control  Unit  which  provides  remote  control  for  the 
HERO  Robot.  The  reucte  control  unit  also  interfaces  with 
microprocessors  through  the  RS-232  loop.  This  system  is  a 
potential  testbed  for  botn  the  reference  system  and  various 
robot  control  algorithms.  Currently,  robots,  like  the  HERO, 
do  not  keep  track  of  their  positions  nor  do  they  have 
sufficient  memory  onboard  to  store  the  programs  for  such 
research.  This  experimental  set-up  provides  both  control 
and  virtually  unlimited  me aory  while  the  cost  and 
complexity  of  the  robot  is  held  to  a  minimum.  With  this 
arrangement,  the  ultrasonic  transmitter  and  receivers  should 
exchange  places  for  the  best  results  and  ease  of 
implementation.  Consequently,  the  remote  receivers 
interface  to  the  microprocessor  via  hard-wired  connections. 
Also,  the  microprocessor  keys  the  ultrasonic  transmitter  on 
the  robot  through  the  radio  remote  control. 

The  literature  on  manipulator  control  is  far  more 
abundant.  However,  no  model  completely  closes  the  position 
control  loop.  At  best,  the  controllers  deal  only  with  the 
motors  and  the  motor  feedback.  The  systems  do  not  directly 
measure  the  errors  which  were  discussed  previously.  These 
systems  rely  upon  error  models  cr  no  models  at  all. 

While  the  three  dimensional  system  herein  does  locate 
the  tip  of  the  manipulator,  the  system  fails  to  identify  the 
orientation  of  the  gripper  cr  tne  rotating  base.  A 
manipulator  with  six  degrees  cf  freedom  needs  additional 
reference  data  to  fully  orient  the  system.  A  possible 
solution  consists  of  optical  calibration  lines  which  can  be 
accurately  located  and  read  on  the  manipulator.  The  optical 
sensors  and  cable  are  small  and  light.  They  will  not  place 
any   further   weight   restrictions  upon   the   arm.      Also, 
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today's  optical  components  interface  directly  onto  printed 
circuit    boards      and    integrated    circuits.  These   advantages 

support    this   approach    very    strongly. 

The  three  dimensional  reference  system  provides  data 
from  which  position  and  velocity  information  may  be 
determined.  While        this      information      is        in      cartesian 

coordinates,  the  conversion  to  other  coordinate  systems  is 
available  and  well  documented.  Microprocessors  handle  these 
conversions  nicely.  As  a  result,  the  myriad  of  manipulator 
control  schemes  have  a  better  testbed  upon  which  they  can  be 
tested.  More  importantly,  the  manipulator  will  no  longer 
require  the  teaching  cycles  which  currently  program 
industrial  robots.  Instead,  the  potential  is  present  for 
the  manipulator,  when  it  is  given  the  various  coordinates, 
to  determine  both  the  commands  and  the  routing  for  each 
task.  Much        of      today's      robotic      research        deals      with 

high-level  hierarchical  languages  for  robotic  control.  tfith 
these  languages,  more  general  commands  such  as  "pick  up 
block"  release  the  programmer  from  the  tedious  task  of 
providing  the  exact  commands  for  all  of  the  motors  involved 
in    the    motion. 

In  summary,  with  the  position  loop  finally  closed  in  the 
robotics  field,  more  positive  control  is  obtainable.  An 
ultrasonic  system  will  not  handle  every  environment. 
However,  with  additional  research,  the  environments  for 
which  ultrasonics  are  suitable  will  be  identified.  The  goal 
of    increased  accuracy  will   become    a   reality. 
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APPEND II  A 
DERIVATION  OF  SENTEY  POSITION  EQUATIONS 

This  derivation  is  a  general  solution  for  an 
intersection  of  two  range  arcs  >hich  are  associated  with  two 
different  reference  feints. 

Coordinate  definitions: 

X  =  XAOF  +/-  XA  =  XBOF  ■*•/-  XB   where  OF  are  the  offsets  of 

Y  =  YAO?  +/-  YA  =  YBOF  +/-  Y3   the  reference  points  from  the 

origin  and  X_  or  Y_  is  the 
respective  distances  to  the 
position  from  the  reference 
joints  in  vector  notation. 

Eange  arc  definitions: 

AE**2  =  XA**2  +  YA**2  where  _r  is  the  radius  of  the 

BE**2  =  XB**2  +  YB**2  arc 

Equate  X's 

XAOF  V-  XA  =  XBOF  +/-  XB 

Solve  the  range  arc  eguations  for  the  vector  magnitude  X_ 
and  substitute  into  the  above  eguation 

XAOF  +/-  (AE**2  -  YA**2)**.5  =  XBOF  +/-  (3B**2  -  YB**2)**.5 

Eearr anging 

+/-  (AE**2  -  YA**2) **.5  =  XBOF  -  XAOF  +/-  (BR**2  -  YB**2)**.5 

Define  DIF  =  XBOF  -  XAOF  and  square  both  sides  of  the  equation 

AF.**2  -  YA**2  =  DIF**2  */-  (2*DIF*  (BE**2  -  Y3**2)**.5)  +  BR**2 
-YB**2 
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Solve  for  +/-  (2*DIF*  (BR**2  -  YE**2)**.5)  and  square  both 
sides  of  the  equation  again 

4* (DIF**2* (3R**2  -  YB**2))  =  AR**4  +  YA**4  +  Y3**4  +  BR**4 
♦  DIF**4  +  2* (-AR**2*YA**2  +  AR**2*YB**2  -  Y3**2*DIF**2 
-  YA**2*YB**2  -  AR**2*BR**2  +  YA**2*3R**2  -  AR**2*DIF**2 
+  YA**2*DIF**2  -  YB**2*BR**2  +  ER**2*DIF**2) 

Substituting   for    YA    and    YE,    and   expanding    the    terms   yields 
the    quadratic    equation  which    was    discussed    in   chapter    2 
(egn    2.2) 

C0EF1*Y**2    +   C0EF2*Y    +   C0EF3    =    C 

where 

C0EF1    =    U*  (YA0F**2    +    YB0F**2    -     2*YA0F*YB0F    ♦    DIF**2) 

C0SF2    =    4*(AR**2*YAOF  -    YAQF**3    -    YB0F**3    -    AR**2*YBCF 
+    YA0F*YB0F**2    +    YAOF**  2*Y30F"  -    BR**2*YA0F 

-  DIF**2*YACF    +    BR**2*YE0F    -    DIF**2*Y30F) 

C0EF3    =    AR**4    +    BR**4    +    DIF**U     *    YA0F**4    +    YB0F**4 

+    2*  (AR**2*YECF**2    -    AR**2*YA0F**2    -    YAO F**2*Y30F**2 

-  AR**2*3fi**2   +    3R**2*YAOF**2    -    AR**2*DIF**2 

+    DIF**2*YAOF**2    -    BR**2*Y30F**2    +    DIF** 2* YB0F**2 

-  BR**2*DIF**2) 
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APPENDIX  B 


PROTECTION  CIRCUITRY  FOR  THE  DRO-LOG  STD  7000 
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APPENDIX  'C 
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APPENDIX  E 


MASTER  WIRING  DIAGRAMS 


REED  3 
RELAYS 

2 

OUTPUT 
PORT 

4 

6 

TRANS- 
MITTER 

1 

5 

Y 

3 

r 

2 

3 

1 

—      QV 

0 

C 
D 
4 
0 
6 
6 

i 

•    h- 

- 

SIG   REC 

ULTRA- 
SONIC 

.RECEIVER 

SIG   REC 

3 

INPUT 
PORT 

2 

.  •     2 

1 

0 

SIG    REC 

1 

.- 

91 


<  0  <A  a: 

h-  2  <  ^" 

Ll  o  o:  h- 

D^H2 

£ 

en 

> 

&         H     ~ 

LU    W      5      - 
K    O     g      J 

5  If   £    2 
o     d 

tr 

o 

LiJ 

h- 

o 

O 

< 

LlJ 

h- 

_J 

_l 

_J 

O 

o 

> 

o 

CL 

Ld 

> 

UJ      . 

o 

UJ 

CL 

92 


1 

< 

o 

CO 

CC 
LU 

CL 

— 

I— 

1— 

z: 

< 

h- 

_l 

o 

CL 

Z> 

en 

\— 

2 

> 


o 

_1 

X 


QC  LU 

o 

LU  O 

rO 

H  < 

2:  u_ 

2 
1 

o 

1—  , 

Dt 

Q.OC 

HO. 

b  o_ 

o 

93 


IIST  OF  REJERENCES 


1.  Everett,  Hobart  R.  A  Microprocessor  Controlled 
Autonomous  Sentry  Robot.  Masfer  of  Science  Th"esis, 
Naval  Postgraduate  School,  Monterey,  California,  19  32. 


4. 


10. 


Productivity      Improvement,"      Robotics:        The      Past     Is 
Prologue  Robotics        -  Research        an3   ~      Business 

®ELQ.E tun i ties ,       .lEEE"      Computer    society   "Press,      Suver 


2.  Weinstein,       Martin      B.         Ancliroid    Design,         Hayden    Book 
Company,    Inc.,    Eochelle   Parle,    TTew~J"ersey,    1981. 

3.  Albus,         James    S.         "Industrial      Robot    Technology      and 
Productivity      Improvem~ 
Prologue  Robotics 
Oj^o r tun i ties,    TEEE 
Spring,    rfaryland,    1982 

Archer,    Data    Sheet,    Remote   Control    Module    Pair    Manual, 
Fort    Worth,    Texas,    19~F5. 

5.  -Polaroid    Corporation,      Data    Sheet,       Ultrasonic    Ranging 

Cistern   Manual,    Cambridge,    Massachuse^TsT  T9~HT. 

6.  Swack,         Richard.         "Application        Note      1,"      Polaroid 
Corporation,    Cambridge,    Massachusetts,    1984. 

7.  Panasonic   Industrial  Company,      Data    Sheet,      Ultrasonic 
Ceramic    Microphones,    Secausus,    New    Jersey,    19"84.~ 

8.  Digital  Research,    Link-80   Operator's   Guide,      Monterey, 
California,    1980. 

9.  Hall,    Douglas    V.      Microprocessors    and   Digital    Systems, 
McGraw-Hill   Bock  Company , lew   York,    1933. 


National    Semi-Conductor      Corporation,      Linear      Circuit 
Data    Book,    Santa   Clara,    California,    1982T" 


11.  IEEE  International  Conference  On  Robotics,  IEEE 
Computer    Society  Press,    Silver    Spring,    Maryland,     1984. 

12.  Keirsey,  D. M. ,  Koch,  E.,  KcKisson,  J.,  Meystel,  A.M., 
and  Mitchell,  J.S.B.,  "Algorithm  of  Navigation  for  a 
Mobile  Robot",  IEEE  International  Conference  On 
Robotics,  IEEE  Computer  SccieTy  Fress,  Silver  Spring, 
Maryland,     1984. 


94 


BIBLIOGEAPHY 


CLavey,    R.      and    Meystel.    A.  "Structure   of    Intelligence    for 

an    Autonomous      Vehicle/"   IEEE  _1S8  4      International   Conference 
on    Robotics.         IEEE    Computer   Society   Press,      '   Silver  "Spring, 


T5aryIan"a'7_T§84 


Digital  Research,  FL/I-80  Ap  plication  Guide,  Monterey, 
California,    1980. 

Digital  Research,  £1/1-30  lan^ua^e  Manual,  Monterey, 
California,    1980. 

Harmon,  S.Y.  "Comments  on  Automated  Route  Planning  in 
Unknown  Terrain,"  IEEE  1984  International  Conference  on 
Robotics,  IEEE  Compulier-S'ocieTv  Press,  Silver  "Spring, 
Mrylana,    1984. 

Siy,  P.  "Road  Map  Production  System  for  Intelligent  Mobile 
Robot.."  IEEE  1984  International  Conference  on  Robotics,  lEEE 
Computer  Society   Press,  "Silver    Spring,    war  ylancl,  TW8WZ 

Zaks,  Rodnay,  Programaing  the  ZSO,  Sybex,  Inc. ,  Berkeley, 
California,    i9H2. 


95 


INITIAL  DISTEIEDTION  LIST 


No.   Copies 


1.  Defense  Technical  Information  Center  2 
Cameron  Station 

Alexandria,  Virginia  2231 4 

2.  Librarv,  Code  0  142  2 
Naval  Postgrauate  School 

Monterey,  California  93943 

3.  Prof.  Harriett  Eigas,Ph.D  1 
Department  Chairman,  Code  62Rr 

Department  of  Electrical  ard  Computer  Engineering 
Naval  Postgraduate  School 
Monterey,  California  93943 

4.  George  J.  Thaler.  Dr.  Eng .  5 
Professor,  Department  of  Electrical  and 
Computer  Engineering,  Code  62Tr 

Naval  Postgraduate  School 
Monterey,  California  93943 

5.  John  P.  Powers,  fh.D  2 
Professor,  Department  of  Electrical  and 
Computer  Engineering,  Code  62Po 

Naval  Postgraduate  School 
Monterey,  California  93943 

6.  Srbijanka  Tura jlic* ,?h- D  1 
Professor,  Department  of  Electrical  and 
Computer  Engineering,  Code  62Tc 

Naval  Postgraduate  School 
Monterey,  California  93943 

7.  David  Smith,  Ph.D  1 
Professor.  Department  of  Mechanical  Engineering 
Naval  Postgraduate  School,  Code  69 

Monterey,  California  93943 

8.  LCDS  Hobart  R.  Everett,  USN  2 
Special  Assistant  for  Robotics 

Naval  Sea  Systems  Command 
Navy  Department 
Washington,  DC  20362 

9.  Richard  Swack  1 
Polaroid  Corporation 

Cambridge  Massachusetts  02  139 

10.  LT  William  M.  Dunkin,  USN  2 
1551-3  Apache  Drive 

Chula  Vista,  Ca.  92010 

11.  Mr.  Don  Redmond  1 
XEBEC 

595  Pastoria  Avenue 
Sunnyvale,  CA   94086 

12  .  Mr.  Tom  Hickox  1 

XEBEC 

595  Pastoria  Avenue 
Sunnyvale,  CA   94086 

96 


3      3  7 


Thesis 
D78956 
c.l 


211217 


Dunkin 

Ultrasonic  position 
reference  systems  for 
an  autonomous  sentry 
robot  and  a  robot  mani- 
pulator arm. 


L21 


Thesis 
DT8956 
c.l 


Dunkin 

Ultrasonic  position 
reference  systems  for 
an  autonomous  sentry 
robot  and  a  robot  mani- 
pulator arm. 


